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OPTIMAL TRIANGULATION 
IN THE PRESENCE OF RANGE 
ERRORS 



A. A. GOLDSTEIN 



I. BERT RUSSAK 



ABSTRACT 



The problem of determining the location of a fixed point using range only 
data occurs in a variety of areas including military applications. An example 
is outlined below and formed the incentive for the work herein. The application 
consisted of precisely locating hydrophones placed on a ship's hull for the 
purpose of receiving acoustic signals to be used in calculating torpedo positions 
during a test. In this paper a method is developed which under the assumption 
of fixed system error input (in range data) produces the smallest possible 
error in locating the hydrophones. 

ANALYSIS 

Our goal is to determine the coordinates of a point in 3-dimehsional 
space. For the purpose of simplicity we first investigate the 2-dimensional 
version of this problem and then extend it to the 3-dimensional case. 

The determination of the coordinates of a point in the plane, requires 
a minimum of two observations. We investigate the geometry of that situation. 

Let positions 1 and 2 be the known observer positions with d the distance 

between them while p is the hydrophone position which is to be determined. 

We assume a coordinate system with 1 at the origin and with x-axis defined by 

1 and 2. The associated figure is below in which r^ and r 2 are the re- 

spective ranges from observers 1 and 2 to p and 0, a are the indicated 
angles. 



1 




The figure is redrawn below with indicated errors Ari, Ar2, A0 respec- 
tively in the ranges r^, r2 and in the angle 6 . An associated new 
location point P' determined from the ranges with errors is also drawn. 







Two Dimensional Triangularization with Errors in the Ranges 
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The vector difference between positions P and P' is indicated by aP 
and is seen to be made up of two components, namely the component Arj along 
r^ and the component r^AB perpendicular to ri. Thus with Irj and lo 
as unit vectors along r^ and perpendicular to it respectively, we have the 
vector equation ; 

1 ) AP = riABl 0 + Aril ri 

Next, according to the law of cosines, we obtain 2a) and 2b) while 2c) is 
justified by the law of sines. 

2a) COA a = ri^ + r?^ - d^ 

2rir2 



2b) C06 0 = ri ^ + d^ - r2^ 

2rid 



2 c) r2 , .Un 0 

^ 6-cn a 



Forming the total differential of 2b), simplifying and solving for A0 gives 



3) A0 = - 1 



rid i'Cn 0 



ri‘"^ + r2^ - d^ Ari - r2^f'2 



2r, 



Next, by using 2a) we get 



4) A0 = - £2_ 



CCA a Ari - Ar2 



rid AX.H 0 
and by 2c) after simplifying 

5) A0 = - 1 



ri A-cn a 



C.Oi> a Ari - Ar 2 



so that after multiplying by ri 
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6) rjAe = Ar 2 - Ari co-i a 

i-oi a 

Using absolute values to consider the worst case situations, i.e. where the 
contributions to riA6 from Arj and Ar 2 add up, we get 

7) |riA0| = ]Ari COA a| + |Ar2l 

a 

It is clear that 7) that for given errors Ar^, Ar 2 then the minimum of the 
worst case situation for rjAe and hence for |1 a?|| occurs when a = II/ 2 , i.e. 
when the lines of sight from 1 and 2 to P are perpendicular. 

Extension to the 3-Dimensional Case 

The previous analysis suggests the following rule for obtaining the 
minimum error in locating the point P in 3-dimensional space. For a given 
set of range errors from the observers, then in the worst case, the resulting 
vector error in locating the point P will be smallest in magnitude if the 
respective lines of sight from the observers are mutually perpendicular. 

This conclusion is also born out by the following alternate analysis; 

Let x,y,2 be the unknown coordinates of the point P and x^j^, y^j^, 
the coordinates of the k— observer and rj^ the range from the k— observer 
to P. Consider the system of equations 

8) \/(x-x^^)2 + (y-y^,^)^ + " '^k 

The procedure used to solve 8) is detailed later but is based on forming 
an approximate solution Xq, y^, Zq to 8) and making a correction 6x, 6y, 5z 
to Xq, yp, Zp. That correction is the solution of the linear equations 
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k = 1,2,3 



9) (xq-x^^)6x + {yQ-y^^,)&y + 

^k,0 

where; r^_„ •'^(V’'sk>" * <Vl'sk>' * <"o-"ek>" ^ ‘ <’'k-''k,o> 

the residual in solving 8) by the approximate solution. 

Writing M as the matrix 



X 

o 

1 

X 


■^0 ' ^si 


^0 ■ ^ S 1 


•^ 1,0 


^,0 


^,0 


^0 ■ ^ S 2 


^0 - ^ S 2 


^0 ■ ^ S 2 


*" 2,0 


•^ 2,0 


*" 2,0 


^0 ■ ^ S 3 


^0 - ^ S 3 


^0 ■ ^ S 3 


*^ 3,0 


*^ 3,0 


*^ 3,0 



then 9) is the system of linear equations 







'sx' 




6ri 


11) 


M 


6y 

5Z 




6r2 

(Sr3 



If r|^ is in error by Arj^ then also 5rj^ is in error by A(6r^) = Arj^ 
Define the vectors 

12a) A(6r) = (A(6ri), A(5r2), A(5r3)) 

12b) Ap (a( 6 x), A( 6 y), A( 6 z)) 

so that in the Euclidean norm 

12c) ||A(tr)l| =y [A( 6 ri )]2 I- [A( 6 r 2 )]^ + [A( 6 r 3)]2 

12d) ||a’?|| = y [a(6x)]2 + [A(5y)]2 + [a(6z)]2 
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Then referring to 11), it is well known that for a given set of A(5r|^) 
k = 1,2,3, then ||a^|| will be smaller, the closer is the condition number 
of M to one (see [1]). By examining the rows of M, one sees that these rows 
are (except for errors in the matrix terms), unit vectors along the lines of 
sight from observers to P. Thus if these lines of sight are made mutually 
perpendicular then the matrix M will be an orthogonal matrix and 11) then 
represents an orthogonal transformation between (a^) and A(6r). For such 
a transformation the condition number is equal to one. 

Thus for the triangulation problem in 3-dimensional space, a given set 
of Ari, Ar 2 , Ar 3 , will produce the smallest ||a?| 1 when the lines of 
sight from the observers form a mutually orthogonal set of vectors. 

Such a situation is accomplished in the following figure in which the 
three observers are in the x-y plane and point P is below the x-y plane. 




Figure 3 

Optimal Observer - Phone Geometry 
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Method of Solution 



The method of solution used is linearized least squares and is novi 
descri bed . 

Let be an initial estimate (the method of determining 

this will be described) of phone position. 



We seek to determine hydrophone coordinates x,y,z such that the following 
equations are satisfied 



13) \/(x-Xsi< )2 + ^-ysk)^+ (z-zsk)2= n< k=l,...,m 



where m is the number of observations and r\ is the observed range from the 
k— observer. 



Let x^^ y^^ 

iterations and let r|< 
to observer k. Thus 



z''> 

( 1 ) 



be the estimates of phone coordinates after i 
be the associated range (computed from 



,z 



(i) 



14) (y^’^-ysk)^ + (z^^^-Zsk)^ = k=l , . . . ,m 

The correction 6x, 6y, 6z to x^^ \ y^^\ is computed as the least 

squares solution of the system. 

15) (x^^ ^-Xsk)6x + (y^^ ^-ysk)'5y + (z^^ ^-zsk)'Sz = f'k-'^k k=l,...,m 



The (i+l)st estimate of phone position is then 



16) 



x(Hl) . x<i) 



+ 6x 



,(i+l) 



= ,(i) 



+ 6y 






+ 6z 



and then equations 15) and 16) are re-solved with i+1 replacing i. Convergence 
of the process is accepted when the change in phone position is less than 10”'^ 
on successive estimates. 



Initial Solution Point for Least Squares Technique 



An initial solution point is necessary in order to use the linearized 
least squares iterative technique described previously. The equations for 
determining that initial point now follow; 
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The figure which indicates the 3-dimensional triangularization is shown 
below with the observers indicated by 1 , 2, 3, and the unknown phone by P. The 
x-y plane will generally coincide with the surface of the water. For ease of 
illustration, P has been drawn above the x-y plane when in reality it will be 
below that plane. However, this distinction will be taken care of by the 
mathematics to follow. In addition: a) for purpose of simplifying the mathe- 
matics, the y axis will be defined as passing through observers 1 and 2 with 
the origin at observer 1 and; b) the angles u, i are as indicated with i re- 
presenting the inclination of the plane containing 1, 2 and P to the x-y 
plane. Z 




Geometry for Initial Estimate 

Writing the coordinates of P we have: 

17) P =ri u coi, -I P =ri c.oi> u 4-cn a 4-cn -i 

' X ^ y i z i 

and with C^, C^, as the coordinates of observer 3 then 

18) r3^ = (ri ^in u co4 -L - C^)^ + (ri co^S u - ^ ~ 
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After squarring terms out, and letting S 3 represent the distance of observer 
3 from the origin so that 

19) S 32 = Cx^ + C/ + 0^2 
we get 

20 ) r 32 = n 2 + S 32 - ZrjCy ao6 a 



2rj 6-in u yj Cx^ + 


C C04 i 

X 


+ sin i 




y ^x2 


y Cx^ + 



Defining the quantities 

21 ) C04 T = Cx iin T = -C 2 

+ 0^2 y Cx2 + 0^2 

and using a trigonometric identity, we solve for the angle ^+x from 20 ) 

22) C04 (-c+t) = -r 32 + rj2 + $32 - 2rjCy co6 a 

2ri iin u yCx2 + 0^2 

We now recognize that x is a small angle (assuming Cj^O) since it mea- 
sures how far observer 3 is out of the x-y plane and all observers will 
nominally be positioned in the x-y plane. Thus the quadrant of c+x is the 
same as the quadrant of Determining ^ from 21), 22) and the remark 

following 22) and multiplying by minus 1 which is consistent with P below 
the x-y plane, - we complete the determination of 1 . Then use 17) to solve 
for the coordinates of P. 

Numerical Results 

In order to illustrate the effect of the geometry on the resultant 
accuracy in determining the phone position, a number of computer runs were 
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made with noise added on to the exact ranges. The nominal range was 100 feet 
and the noise was generated from a uniform random number generator with mean of 
zero and maximum noise magnitude of .1 ft (which is representative of the equip- 
ment being used). Using the ranges, from the three sightings, each run had 
different angles between their respective lines of sight to the phone. 

We give the results as errors Ax, Ay, Az in determining the various 
components x,y,z of hydrophone position. In addition we also list the square 
root of the sum of the squares of the component errors and call this ||a^||. 
Finally, each run is actually the result of four sub-runs each with a different 
noise sample. The results listed are for the sub-run with the largest value 
of llAfll. 



Table 1 

Range = 100 Feet 



Angle between 
Lines of Sight 


AX (feet) 


Ay (feet) 


Az(feet) 




1 1 A?1 1 =*^Ax2 + Ay2 + az2 (fe 


15° 


.21 


.33 


.03 


.40 


30° 


.11 


.17 


.03 


.20 


45° 


.07 


.11 


.03 


.14 


60° 


.06 


.09 


.03 


.11 


90° 


.04 


.06 


.04 


.09 


110° 


.03 


.05 


.08 


.n 



The above table bears out the theoretical result obtained previously 



namely that the errors in locating the hydrophone are minimized when the 
lines of sight from the observers to the hydrophone are mutually perpendicular. 

The method considered here is invariant to range changes and this is 
shown by running a case with the ranges at 1,000 feet. 
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Table 2 



Range = 1 000 feet 



Angle between 
Lines of Sight 


Ax (feet) 


Ay( feet) 


Az( feet) 


II A^ = + Ay2 + Az^ ( feet 


LI3 

O 

o 


.04 


.06 


.04 


.09 
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